/*
 * To change this template, choose Tools | Templates
 * and open the template in the editor.
 */
package edu.ortn.wildbots.commands;

import edu.ortn.wildbots.subsystems.Elevator;
import edu.wpi.first.wpilibj.DriverStationLCD;

/**
 *
 * @author Stephen
 */
public class ElevatorControl extends CommandBase{
    
    public ElevatorControl() {
        requires(elevator);
    }

    // Called just before this Command runs the first time
    protected void initialize() {
        elevator.reset();
    }

    // Called repeatedly when this Command is scheduled to run
    protected void execute() {
        elevator.update();
        DriverStationLCD lcd = DriverStationLCD.getInstance();
            String[] data = elevator.getData();
            /*
            lcd.println(DriverStationLCD.Line.kMain6, 1, data[3]);
            lcd.println(DriverStationLCD.Line.kUser2, 1, data[4]);
            lcd.println(DriverStationLCD.Line.kUser4, 1, data[0]);
            lcd.println(DriverStationLCD.Line.kUser5, 1, data[1]);
            lcd.println(DriverStationLCD.Line.kUser6, 1, data[2]);
            lcd.updateLCD();
            * */
           
    }

    // Called once after isFinished returns true
    protected boolean isFinished() {
        return false;
    }

    // Called once after isFinished returns true
    protected void end() {
        elevator.reset();
    }

    protected void interrupted() {
    }
}